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Beschreibung 

Die Erfindung bezieht sich auf ein Verfahren zur kontinuierlichen und automatischen Fahrzeugorientierung 
auf einer Fahrbahn mit einem bilderzeugenden System und einer computerisierien Bildauswertung zur Erzeu- 
5 gung von Fahrzeugsteuerdaten. 

Aufgrund einer wachsenden Verkehrsleistung ist eine immer starkere Transportkapazitatsauslastung von 
Verkehrswegen unvermeidlich. 

Derzeit stdBt diese Erweiierung jedoch auf eine Begrenzung, die durch den Menschen wegen seiner psychi- 
schen und physischen Moglichkeiten als Fahrzeugfiihrer vorgegeben ist. 
10 Als Ausweg bietet sich der teilweise oder vollsiandige Ersatz des Fahrzeugfuhrers durch eine automatische 
Fahrzeugfuhrung an, die auch schon unter den gegenwartigen Bedingungen zur Erhohung der Verkehrssicher- 
heit und Komfortsteigerung wiinschenswert ware. 

Zur Realisierung einer automatischen Fahrzeugfuhrung ist es notwendig. wenn sich der Ersatz des Menschen 
nicht nur auf eine bloBe Geschwindigkeitsregelung beschranken sol!, uber ein System zu verfugen, welches die 
15 selbststandige Orieniierung des Automaten auf der Fahrbahn ermoglicht 

Bisher zu diesem Zweck geschaffene Einrichtungen sind hierzu nur sehr eingeschrankt fahig. 

So ist z, B. ein Automat zur Fahrzeuglenkung aus dem EUREKA-Projekt ^'Prometheus" bekannt. 

Diese Einrichtung weist zur Orientierung und Lenkung des Fahrzeuges auf der Fahrbahn eine Kamera auf, die 
so ausgerichtet ist, daB sie die rechte Fahrbahnbegrenzung anvisiert. 
20 Aus dem erzeugten Bild wird mitteis eines compuierisienen Auswerteverfahrens versucht. nach Farbkonira- 
sten eine Leitspur zu ermitteln. 

Die Spur dient dann als Bezug fur die Fahrzeugsteuerung. 

Abgesehen von der Mogiichkeit ein Kraftfahrzeug schienenfahrzeuggleich auf einer StraGe fuhren zu konnen, 
mu3 als hauptsachlicher Nachteil dieser Vorgehensweise festgestellt werden, daB es so nicht moglich ist, sich am 
25 tatsachlichen Fahrbahnverlauf zu orientieren. 

Eine vorausschauende Bewertung des weiteren StraBenverlaufs isl nicht moglich. 

Des weiteren fuhren IContraste, die einen Eindruck einer Spur verursachen, aber nicht in Fahrbahnrichtung 
verlaufen, bzw. etwaige Ausloschungen des vom System z. B. als Spur aufgefaBten Randstreifens durch Brems,- 
spuren, Schlagschatten etc., zu nicht akzeptablen Funktionsausfallen. 
30 Eine andere diskutierte Einrichtung zur automatischen Fahrzeuglenkung tragt die Bezeichnung *Train". 

Zur Sichersteliung einer fortwahrend zuverlassigen Lenkung ist es bei ihr vorgesehen, die Kamera und die 
zugehorige Bildauswertung gegen einen Stromabnehmer, der zugleich ein seitliches Fuhrungssignai erzeugen 
kann, auszutauschen. 

Dem Vorteil der exakten zuverlassigen Fahrzeuglenkung steht hier allerdings der erhebliche Nachteil gegen- 
35 iiber, nur auf StraBen zu funktionieren, die iiber eine entsprechende Ausrustung verfiigen. 

Wegen der erwahnten Unzulanglichkeiten der bisher in Realisierung bzw, Diskussion befindiichen Systeme 
zur automatischen Fahrzeugfuhrung stellt sich die Erfindung die Aufgabe, ein Verfahren zu schaffen, welches 
implementiert in eine Einrichtung zur automatischen Fahrzeugfuhrung^ diese in die Lage versetzt, monokulare 
Bildfolgen einer am Fahrzeug montierten Kamera modellgestutzt zur raumlichen Fahrbahnverlaufserfassung zu 
40 interpretieren. 

GemaB der Erfindung wird diese Aufgabe dadurch geldst, daB von einer Fernsehkamera. die moglichst hoch 
uber der Fahrbahn am Fahrzeug aufgehangt ist, standig digitalisierte Bildfolgen im Videotakt an ein Rechnersy- 
stem tnit einem Programm zur speziellen verfahrensgemaBen Ausgestaltung der Signalverarbeitung und Inter- 
pretation im Fahrzeug ubertragen werden. 
45 Im Verfahren werden generische StraBenmodelle und einfache generische dynamische Modeile fur die Fahr- 
zeugbewegung ausgenutzt, um bisher enthaltene Ergebnisse der Fahrbahn- und Fahrzeugrelativlage — Erken- 
nung zur Auswertung des nachsten Bildes verwenden zu konnen. 

Hierzu werden drei Teilmodelle kombiniert. 

Monokulare Bilddaten nur des letzten Bildes werden mit rekursiven Schatzverfahren zur Bestimmung der 
50 Straflenparanieter und des eigenen Relativzustands ausgewertet. 

Dadurch entsteht im Rech'ner eine raumliche Vorstellung des aktuellen StraBenverlaufs im Vorausschaube- 
reich. 

In vorteilhafter Weise gelingi dabei eine Umsetzung von Veranderungen im Bild in regelungsorientierte 
ZustandsgroBen innerhalb nur eines Verfahrenszyklus. 
55 Im folgenden wird das Verfahren zur kontinuierlichen und automatischen Orientierung auf einer Fahrbahn 
naher erlautert in der folgenden Anlage. 

l.Modeilgestutzte Bildfolgen- Interpretation zur raumlichen Fahrbahnverlaufserfassung 

60 1.1 Die modellierten Fahrzeug- und Fahrbahn- Freiheitsgrade 

Die Modellierung siellt das zur "hoheren" Interpretation notige, meist anwendungsspezifische. Vorwissen 
iiber eine Szene dar. Erst hiermit wird eine Umsetzung vom "anonymen" Bildsignal in problemorientierte 
Bedeutung moglich. 

65 Der 4D-Ansatz zur Bildfolgeninterpretation nutzi die Modellierung raumlich-geometrischer und zeitlich-dy- 
namischer Aspekte einer Szene und ihrer Veranderungen. Diese raum/zeitliche Modellvorstellung leistet in 
fCombination mit rekursiven Schatzverfahren in der hier beschriebenen Anwendung zur StraBenfahrzeugfuh- 
rung sowohl die Erkennung des fahrzeugeigenen Lateralzustandes relativ zur Fahrbahn, als auch die Erfassung 
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des raumlichen Fahrbahnverlaufes aus der 2D-Bildfolge wahrend des Entlangfahrens. Hierfur existieren zwei 
schwach gekoppelte dynamische Teilsysteme: das der Fahrzeug-Querdynamik sowie der Fahrbahnkrummungs- 
dynamik. 

Die Struktur des Differentialgleichungssystems. das die Fahrzeugseitenbewegung bzw. die Fahrbahnkrum- 
mungsdynamik beschreibt, die geometrlschen Modell- und Abbildungsparameter, das eingesetzte Zustands- 5 
schatzverfahren (Kalman Filter) sowie die zugehorigen Kovarianzen der MeQfehler und ProzeBstorungen 
stellen "analytisches Wissen" [Isermann u. Nold, 88] uber den optisch zu erfassenden (und in der Foige zu 
steuemden) ProzeB "Entlangfahren an einer StraBe" dar. 

Die wesentiichen modellierten — und damit erfaBbaren — Freiheitsgrade und ihre Auswirkung auf das Bild 
der Fahrbahn sollen im folgenden qualitativ veranschaulicht werden (Bild la bis e): 10 

Es zeigen im einzelnen Bild: 

a) EinfluB einer Seitenablage von der Fahrbahnmitte nach rechts. 

b) EinfluB eines Gienvinkels zwischen Fahrzeuglangs- bzw. ICameraachse und Fahrbahnrichtung nach links, 

c) EinfluB von horizontaler Fahrbahnkriimmung (Kurven) - 15 

d) e) EinfluB von vertikaler Fahrbahnkrummung (Steigungsanderungen) 

Bild 1 : Mogliche Erscheinungsbilder der Fahrbahn. Der Referenzverlauf der Fahrbahnbegrenzungen fiir eine 
zentrierte, ausgerichtete Fahrzeugposition auf ebener und gerader StraBe ist jeweils mit dunner Strichsiarke 
eingezeichnet 20 

12 Geometrisch-raumliche Modellierung — das Fahrbahnmodell 

12.1 AUgemeines zum Fahrbahnmodell 

25 

Der raumliche Fahrbahnverlauf (bzw. der einer Skelettlinie) wird irn wesentiichen durch die geomeirischen 
Parameter der horizonialen bzw. vertikalen Fahrbahnkrummung (coh, cov) uber der Lauflange beschrieben (vgl. 
Bild 2). Die Fahrbahnbegrenzungen werden als parallel verlaufend mit Abstand b angenommen. Die Fahrbahn- 
wdlbung und -verwindung, d. h. Anderungen des Hangewinkels^ innerhalb des Vorausschaubereichs seien ver- " . 
nachlassigbar klein. . . ~ 30 

Bild 2 gibt einen raumlichen Fahrbahnverlauf mit horizontaler und vertikaler ICrummung wieder. 

Die horizontale Kriimmung coh (Kriimmungsradius Rh = 1/coh) kann sich linear mit der Lauflange \ andern 
(dcoh/d2 = cth = const.). Dies entspricht den grundlegenden Bauvorschriften und Auslegungskriterien fiirStraBen 
fiir hohere Fahrgeschwindigkeiten [RAS-L-1» 84]. Der Fahrbahnverlauf im Lageplan (d. h. in der Draufsicht) 
besteht somit aus Segmenten konstanter Kriimmung, also Geraden und stationaren Kurveni sowie aus Kurven- 35 
ubergangen mit sich linear andernder Kriimmung (Klothoiden). Kuppen und Wannen im Hohenverlauf haben 
naherungsweise Kreisform (in Realitat durch quadratische Parabeln approximiert). 

Abgesehen von der unmittelbaren Bedeutung der horizontalen Fahrbahnkrummung fiir die Seiten- und 
Langsfiihrimg des Fahrzeugs [Dickmanns u. Zapp, 86] laBt sich uber die lokalen Kriimmungsparameter der 
raumliche StraBenverlauf im Vorausschaubereich sehr. effizient geometrisch. in einem beobachterbezpgenen, 40 
mitbewegten Koordinatensystem beschreiben. Daruber hinaus lassen sich die zeitlichen, iiber den Vorausschau- 
bereich gemiitelten Beziehungen zwischen coh, cih und coh aufgrund des Entlangfahrens mit bekannter Eigenge- 
schwindigkeit v als kompaktes System linearer Differentialgleichungen formulieren, wie von [Dickmanns, 88] 
vorgeschlagen. Dies gilt weitgehend analog auch fur die Vertikalkriimmungsparameter cov» civ und cov- D. h. es 
existiert ein dynamisches Modell der Fahrbahn-Krummungsparameter, das in Verbindung mit der geometri- 45 
schen Modellierung und den bekannten AbbildungsgesetzmaBigkeiten die Bestimmung dieser GroBen aus der 
Bildfolge mittels rekursiver Schatzverfahren erlaubt (vgl. Abschnitt 13). 

\2J2 Das lineare Kriimmungsmodell zur Beschreibung des Fahrbahn verlaufs 

50 

In. der Linienfiihrung von StraBen fiir mittlere und hohere Fahrgeschwindigkeiten wird u. a. die Fahrdynamik 
dadurch beriicksichtigt, daB Kriimmungsanderungen, und damit auf das Fahrzeug wirkende Querkraftanderun- 
gen» nicht sprunghaft, sondern stetig verlaufen. Dies wird durch Kurvenubergange (Klothoiden) mit sich linear 
iiber der Lauflange 1^ andernder Kriimmung erreicht, d. h. es gilt 

55 

c(l)=co + c, . 1. (1) 

Hierbei ist c=l/R (Kurvenradius R) die lokale Kriimmung an der Lauflangenkoordinate \ und c© der 
Anfangswert der Kriimmung am Ort \ — Q. 

60 

Ci=dc/d2' (2) 

stellt die abschnittsweise konstante Kriimmungsanderung iiber der Lauflange dar, die mit dem sog. Klothoiden- 
parameter A iiber C| = 1/A^ zusammenhangt (vgl. [RAS-1 -L. 84). 

Der Fahrbahnverlauf im Lageplan kann somit durch die Horizontal-Kriimmungsparameter als Abfolge von 65 
Geraden, Kurveniibergangssegmenten (Klothoiden) und Kreisbogen dargestellt werden: 
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Gerade: co = 0 undci=0 

Obergangsbogen: co=9*=0oderco = 0 undci^O 
ICreisbogen: co#0 undci=0 

Die Fahrbahnrichtungsanderung Axc (Bild 3) ergibt sich in Anwendung der Definition fiir die Kriimmung 
c = dxc = dx/d| in der Differentialgeometrie als I ntegral der Krummung uber der Lauflange mit GL (I ) zu 


A I 


Ax. = J 

0 


c(X) dX = CqAI + c, — -. (3) 


15 Die durch die Richtungsanderung iiber der Lauflange auftretende laterale Ablage Aye von der ursprungiichen 
Tangente (Bild 3) wird durch einen weiteren Iniegrationsschritl bestimmu 
Bild 3 stellt die lokale Geometric eines Bogensegments dar. 

Fur kleine Winkelanderungen Ax < 1 (mit sinAx ""d cosAx=s 1 und GL (3)) lassen sich in einem kartesischen 
Koordinatensystem folgende Naherungsbeziehungen fiir die Langs- und Querablage eines Punktes an der 
20 Lauflangenkoordinate A_[ auf der Klothoide angeben: 

AVc = I sin lx(X)] dX = I xM dX = oc + ,c (4) 

0 u 


Ax - J cos(x{X)) dX - J dX - Al , (5) 


Abschatzungdes Linearisierungsfehlers 

Bei einer maximalen Vorausschauentfemung von A_[ = 20 [m] und einer Krummung von co = 0,01 [l/m] (Kur- 
35 venradius 1 00 m) ergibt sich folgender Naherungswert fur die Querablage: 

Al2 

Ayc = Co-y- «2.0[m]. 


Gegenuber dem mathematisch exakten Wert 

Aycex = — * (1— cosAx)^ 1,99 [m] mit Ax = Al • co 
Co ~ 


. betragt der Fehier durch die Linearisierung also ca. 0,5%. 

Entsprechend [RAS-1 -L. 84] werden Steigungsanderungen der Fahrbahn durch im Vertikalprofil parabolische, 
naherungsweise kreisformige Obergangssegmente (Wannen u. Kuppen) realisiert. Als Parameter der Fahrbahn- 
50 Vertikalgeometrie werden hier die uber die Vorausschauweite gemitteite vertikale Fahrbahnkrummung covm, 
sowie — als HilfsgroQe zur dynamischen Modellierung (speziell beim Obergang von ebenen zu vertikal ge- 
krummten Fahrbahnbereichen, vgl. Kap. 32) — die mittlere Anderung der Vertikalkrummung uber der Lauflan- 
ge civm =dcvm/d_[ angesetzt. 

Analog zu GL(1) bis (4)gilt dann fiir die Fahrbahn-Hohenanderung AHcv aufgrund vertikaler Fahrbahnkriim- 
55 mung Qber der Lauflange Al^ (ausgehend von horizontaler Fahrbahn): 

AO . _ 

AHcv = COvm— ^ + Civm— 7^ (6) 


1.2.3. Die horizontale Fahrbahn- und Abbildungsgeometrie 


Im Fahrbahnerfassungs-Modul gehen die raumliche Fahrbahngeometrie und die perspektivischen Abbil- 
dungsgesetzmaBigkeiten explizit in den ErkennungsprozeB mit ein. 
65 Es zeigt: 

Bild 4: Horizontale Fahrbahn- und Abbildungsgeometrie. Der Fahrzeugschwerpunki ist mit SP gekennzeichnet, 
das Projektionszentrum der ICamera durch PZ. 

Fur die GroQen in Bild 4 gilt folgende Indexkonvention: 
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V = Fahrzeug; K Kamera, R = Fahrbahn, B = in Bildkoordinaten, 
g =s= rel. zu geodatischem Koordinatensystem. 

Die horizontale Bildkoordinate ys eines Fahrbahnrand-Kantenelementes in der Vorausschauentfemung L 
vom Projektionszentrum (PZ) wird durch die Abbildungsparameter sowie folgende GroSen der Kamera- und 
Fahrzeug-Relativlage bzw. der ebenen Fahrbahngeometrie bestimmt: 

f — Brennweiie[mm], 

ky — Kameraskalierfaktor (horizontal) [pxt /mm], 
L — Vorausschauentfemung [mj 

d — Abstanddes Projektionszentrums vom Fahrzeugschwerpunkt[mJ 
VKV — Kamera-Gierwinkel relativ zur Fahrzeuglangsachse [radj 
yv — Ablage des Fahrzeugschwerpunkts von der Fahrbahnmitte [m\ 
, vv — Gierwinkel zwischen Fahrzeuglangsachse und Fahrbahntangente [rad], 
b — Fahrbahnbreite [mj 

cohm — mittlere horizontale Fahrbahnkrummung[l/m]. 

cihm — mittlere horizontale Fahrbahnkrummungsanderung[l/m^ 

Fiir alle Winkelbeziehungen der horizontalen Abbildungsgeometrie werden vereinfachend die Linearisierun- 
gen der trigonometrischen Grundfunktionen sin(\|/) = \|/ bzw. cos(\j/)=il benutzL Fur kleine Winkel |\|/|<10" 
betragt hierbei der maximale Fehler ca. 1,5%. Wegen des kleinen Verhaltnisses von Brennweite zu Vorausschau- 
entfemung (f/L<l) bzw. des kleinen Abstandes zwischen Projektionszentrum und Kameradrehpunkt wird 
naherungsweise fur die weiteren Herleitungen die Lage des Projektionszentrums, der Bildebene und des 
fCameradrehpunktes auf der optischen Achse als identisch angenommen. 

Es ergeben sich somit in einer Vorausschauentfemung L von der ICamera- Bildebene folgende (laterale) 
Abiageanieile der Fahrbahnbegrenzungen von der Fahrspurmitte (vgl. Bild 4): 

yRg=yc±y (6) 

wobei + b/2 fiir den rechten und — b/2 fur den linken Fahrbahnrand gilt, und 
(L+d)^ • CL + d)3 

yc^-^ — ^-^COhm-f-^^ — g-^Clhm (7) 

gemaB GI. (1 .4) im vorigen Abschnitt. 

Enisprechend gilt fur die Ablage der Fahrbahnbegrenzung von der Kamera-(Biickrichtungs)-Achse (vgl. Bild 

yRK-=yRg-(yv-i- yw+ yvKv W . 
mit 

y^,={L+d) . v|/v (9) 
und 

yvKv^^- • VKV. (10) 
Die Perspektivabbildung 

ys -^ y^^ (1^) 

ergibt mitcy^^b^f * fiir die horizontale Bildkoordinate (skaliert in Pixel-Einheiten [pxl]) eines Kantenelemen- 
tes der Fahrbahnbegrenzungen in der Vorausschauentfemung L 

Vb = — ^±y -yv-y,^-y«,, + ycj- (12) 

Die entsprechenden Elemente der Jacobischcn Matrix C der Abbildungsgleichungen fiir das ebene und 
raumliche Fahrbahnmodell sind im Anhang A2 angegeben. Im ebenen Fall ist die Vorausschauentfemung L nur 
von der Kameraneigung gegenuberder Fahrbahn sowie von einer gewahlten Bild-Vertikalkoordinate(Bildzeile) 
abhangig. Weist die Fahrbahn auch vertikale Kriimmung auf, so geht diese in die Berechnung der Vorausschau- ' 
entfernung mit ein (s. folgender Abschnitt). Dia im raumlichen Fall die Vertikalkrummungsparameter des Zu- 
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standsvektors des dynamischen Fahrbahnkrummungsmodells sind, werden dann die Abbildungsgleichungen 
vom momenianen Vertikalkrummungszustand abhangig, und damit nichtlinear bezuglich des Zustandsvektors. 

1.2.4 Die vertikale Fahrbahn- und Abbildungsgeometrie 

5 

Die vertikale Abbildungsgeometrie wird im wesentlichen von der venikalen Kameraposition und -Nicklage 
relativ zur Fahrbahn sowie von einer evtl. vorhandenen vertikalen Fahrbahnkriimmung bestimmt (vgL Bild 5). Es 
wird angenommen, daB die Fahrzeug-Langsachse immer parallel zur Fahrbahn-Tangentialebene am Ort des 
Fahrzeug-Schwerpunkts liegt, d h. hochfrequente Nicklagestorungen kleiner Amplitude werden vernachlassigL 

10 Dies hat sich f ur stationare Fahrzustande auf "normalen", d. h. glaii asphaitierten StraBen als realistisch erwiesen. 
Allerdings gilt dies nicht fur unebene StraBen oder bei starken Beschleunigungs- und Abbremsmanovern, die 
deuiiiche Nickbewegungen verursachen konnen. Urn diese Falle bei gleichzeitiger korrekter Erkennung der 
Fahrbahn venikalkrummung bzw. Fahrbahnbreite behandein zu konnen. ware eine direkte Erfassung oder 
Schatzung der Fahrzeug-Nicklageanderung erforderlich. 

15 Verdeutlicht wird in Bild 5 die vertikale Fahrbahn- und Abbildungsgeometrie. 

Die benutzten GroBen der venikalen Fahrbahn- und Abbildungsgeometrie sind im folgenden zusammenge- 
faQt: 

f — Brennweite[mm], 
20 kz — Kanieraskalierfaktor(veriikal)[pxl/mm]. 

d — Abstanddes Projektionszentrums vom Fahrzeugschwerpunkt [m], 

Hk — Hohe der Kamera uber der Fahrbahntangentialebene [mj 

0K — Kamera-Nickwinkel relativ zur Fahrzeuglangsachse[rad], 

2B — Bild-Vertikalkoordinate in Pixel-Einheiten [pxl], 
25 Lo ~ Vorausschauentfernung bei ebener Fahrbahn [mj 

Lev — Vorausschauentfernung bei vertikal gekrummter Fahrbahn [m], 

Hcv — Hohenanderung aufgrund vertikal gekrummter Fahrbahn [m], 

covm — mittlere Vertikalkrummung der Fahrbahn [1/m], 

civm — mittlere Vertikalkrummungsanderung der Fahrbahn [l/m^]. 

30 

Die z'ur Berechnung der Jacobischen Matrix C der MeBgleichungen (CI. (12)) erforderliche Vorausschauent- 
fernung Li= L(zBi, Hk. ©k. f, kz. covm. civm) wird bzgl. einer ausgewahlten Bild-Vertikalkoordinate (Bildzeile) ZBi 
wie folgt ermitteh: 

Die Neigung des Sehstrahls durch zsi gegenuber der Fahrbahntangentialebene ergibt sich zu 

35 

02Bi=-®K + arctan-r^ (13) 


40 Im Falle einer ebenen Fahrbahn berechnet sich die der Bildvertikalkoordinate ZBi entsprechende Voraiis- 
schauentfernung zu 

45 

GemaB Gl. (6) gilt fur die Fahrbahnhohenanderung durch eine mittlere Vertikalkrummung bzw. Krummungs- 
anderung uber der Lauflange Lcv + d (d. h. relativ zur lokalen Fahrbahntangentialebene am Ort des FZG- 
Schwerpunktes) 

50 


55 Mit GL(13) laBt sich die Fahrbahnhohenanderung innerhalb der Vorausschau abhangig von zai ausdrucken als 
Hcv = Hk:-Lcv • tan02Bi 0^) 
Aus ( 1 6) und ( 1 5) folgt f iir Uv ein Polynom 3. Ordnung 

60 

asUv^ -i- a2Lcv^ + ai Lev -{- ao = 0 (17) 
mit den Koeffizienten 

65 
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Civn 

a3= — 


a2=* -^(covni + d • Civmj. 

ai =d . (covTn+ A.l|l:mL) +tan0zBi. 


ao= X + r Hk, 


und Gi. (16) ergibt sich die vereinfachte, quadratische Gleichung 
Lcv^ + tan0zBi Uv-Hk-O (19) 

fur Lev nriit den Losungen 


+ 4-^-^>0 (21) 


gilt Dies ist erfiillt, solange die Vertikalkrummung groQer als der Grenzwert 
I lan^ elg, 

COvm ~ ~ Y ^ + ^<^Orcs (22) 


to 


das Qber die Newton-Iteration [Heinhold u. Behringer, 76] numerisch gelost wird. Wenn als Iterations-Startwert 
fur Lev die Losung des jeweils vorhergehenden Abtastiniervalls (oder auch der Wen fur den ebenen Fall gemaB 15 
Gl. (14)) eingesetzt wird, konvergiert die Iteration typischerweise in 2— 3 Schritten. d. h. der numerische Rechen- 
aufwand isi relativ gering. 

Durch Vernachlassigen des civm-Einflusses auf die Vorausschauweite laOt sich das Polynom Gl. (17) auf 2. 
Ordnung vereinfachen und ist damit direkt analytisch losbar (vgL GL (19) unten). Der covm-Schatzwert folgt 
einem Sprung im realen Vertikalkrummungsverlauf wegen der Mitlelung iiber die Vorausschauweite jedoch nur 20 
leichi verzogert C^erschleifungseffekt"). Ein Vernachlassigen des cwm-Einflusses bewirkte beim Einfahren in 
vertikal gekrummte Fahrbahnbereiche Fehler in der Vorausschauentfernuiig und entsprechende Differenzen in 
der erwarteten Breite des Fahrbahnbildes. Das seitliche Nachfuhrverhalten der Auswertefenster auf die mit 
einer Vertikalkrummungsanderung verbundene Breitenanderung des Fahrbahnbildes konnte durch explizite 
Beriicksichtigung des Civm- Einflusses deutlich verbessertwerden. 25 

Ab einer gewissen negativen Vertikalkrummung der Fahrbahn kann der Fall eintreten. daB das Fahrbahnbild 
unterhalb der gewahlten Bildzeile ZBi liegt, also auf der Hohe von zbi keine Kantenelemente als Merkmale 
extrahierbar sind. Der Krummungswert fur diesen Grenzfall (bei dem der Sehstrahl durch zei die Tangente an • 
die nach unten gekrumrnte Fahrbahn in der Entfernung Uv bildet) laBt sich naherungsweise. unter VernachlassI- " 
gung des cwm- Einflusses, aus einem Polynom 2. Ordnung fur Lev abschatzen. Aus 30 

Lcv^ 

Hcv = Covm — (18) 


35 


40 


Der Grenzfall fur die maximale negative Kriimmung CTangentenfall") abhangig von ZBi wird dadurch be- 
stimmt. daB der Ausdruck unter der Wurzel > 0 sein muB fiir reelle Losung von Lev. also 

50 

/2 tane, Y 


55 


60 


ist, wobei wegen der Vernachlassigung von d und ct vm noch ein "Sicherheits-Abstand" Acorcs = 0»0005 gegeniiber 
dem Tangentenfair-Grenzwert aus dem quadratischen Ansatz eingefuhrt wurde. 

Falls GL (22) nicht mehr erfullt ist, entfallt die Berechnung der zsi entsprechenden Vorausschauentfernung, da 
die Nullstelleniteration fur GL (17) keine (hier) sinnvolle Losung ergeben kann. Da zudem in der Bildzeile ZBi ein 
Fahrbahn-Kamenelement nicht mehr zuverlassig extrahierbar ist, wird bei der sequentiellen Zustands-Innova- 55 
tion des Kalman Filters der entsprechende MeBwert ausgelassen (vgL Abschnitt 1.43.1). 

Als zusatzliche Beschrankung sind die Vertikalkrummungsparameter auf die bei einspurigen StraBen im freien 
Gelande als maximal angenommenen Wertebereiche von — 0,003 < covm ^ 0,005 bzw. — 0,00015 <civni< 0,000 15 
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begrenzt (d. h. auf Krummungsradien zwischen 330 m negativ und 200 m positiv, bei einer maximalen vertikalen 
Kj-ummungsanderung von ebener StraBe auf 300 m Radius innerhaib 20 m Vorausschau). 

13 Dynamische Modellierung 

5 

13.1 Die horizontale Fahrbahnkrummungsdynamik 

In Bild 6 sind fur eine S-Kurve im Fahrbahnverlauf qualitativ die horizontale Krummung bzw. Krummungsan- 
derung uber der Launange (entsprechend dem linearen FCrummungsniodell. vgl. Abschnitt 1^^) sowie deren 
10 zeithche Anderung aufgrund des Entlangfahrens nriit einer konstanten Geschwindigkeit dargestellL Fur die 
Zeitabieiiungder Krummung coh gilt: 


15 


dcph dcQh dl 


dt 


dl 


dt 


= cih • V. 


(23) 


20 


25 


30 


35 


Zur besseren Unterscheidung von der Ziffer 1 ("EinsT wird die Lauflangenkoordinate 1 immer mit Unterstrich 
geschrieben. 

Es zeigt Bild 6 den Fahrbahnverlauf und horizontale KrummungsgroBen. 

Die Unstetigkeit des cih-Verlaufs iiber der Lauflange bewirkt theoretisch Dirac-Impuise in der Zeitabieitung 
cih. die real bzw. als Differential-Beziehungen nicht modellierbar sind Dies laBt sich jedoch umgehen. wenn 
hierfur naherungsweise uber den lokalen Vorausschaubereich L gemittelte GroQen cohm und cihm eingefuhrt 
werden. die in ihrem "Krummungs-Effekt" uber L dem der theoretischen GroBen coh und cih uber U aquivalent 
sind. d. h. die gleiche Krummungsablage Aye erzeugen (vgl. Bild 7). Dieser Ansatz wurde von [Dickmanns, 88] 
vorgeschlagen. Es soil also gelten : 

Aycm(cohm, cihm, L) = Ayc(coh» cihJc). (24) 
Zur Verdeutlichung 

Bild 7: Die durch die gemittelten Krummungsparameter (cohm, cihm) uber die Vorausschauentfernung L bewirk- 
te Ablage Aycm ist gleich der uber die "Eindringtiefe" U in den cih-rStufenbereich auftretenden Querablage Aye. 
Die Beitrage der gemittelten GroBen zur Querablage 

Aycm = Aycohm + ^Yci hm (25) 
sind 


40 


. ^ycihm = Clhm(lc) (26) 


45 


50 


55 


und 


^ ycohm ~ ^Ohm (ic) * "2 


Cihm W dA 


(27) 


Fur Ayc(l c) gilt im Bereich 0:5 l^c ^ L 


Ayc(lc)=cih (28) 


Gleichsetzen von Gl. (25) mit Gl. (28) und Differenzieren nach J^c ergibt fur cihm folgende Differentialgleichung: 


60 .""'^ 2 die • "6" '^^^'"^ • ~- (^^^ 


65 


Die Substitution 
0<5< 1) ergibt 


dcihm 


dl 


— =c'ihm und eine Normierung auf L mit 5= (d. h. fur die normierte Eindringtiefe gilt 


c'ihm(^) = 3^2e,h_3cjhm(?). (30) 

Z. B. via Laplace-Transformation isl folgende Losung herleitbar: 
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cihm(a-cihrn(0)e-^^+cih(5^--y^+y(l-e-^)). (31) 


Am Ort des cih-Sprungs (d h. an 4— 1 bzw. U = L) mit dem Anfangswert cihm(0) = 0 ergibt sich als Amplitude 
des gemittelten cih-Verlaufes 


cihm(l)-cih(l- y + y (^~^"^)) ^^^^ ■ ^•^5* 


(32) 


Ab 1 liegt der Vorausschaubereich L voll im cih-Stufenbereich. Es wird eine neue, um L gegenuber U (bzw. 
normiert um 1 gegenuber Q nach rechts verschobene Laufkoordinaie ^' = 5— 1 eingefuhri. 

GI. (24) gilt nach wie vor. jedoch ist nun im Vorausschaubereich der Krummungs-Anfangswert coh(^')#0. 
Damit ergibt sich fur die Querablage des StraQenrandes von der.Tangente infolge der Kriimmung 

Ayc<L) = coh • y + cih • — « cohm • — + cihm • -g- = Aycm(L) (33) 

bzw. nach Normieren auf L 
coh+y^-cohm (34) 

, Gl.(34) differenziert nach 4- ergibt. mit dcoh/d^' = cih 
y^d^ (35) 

bzw. mit der Substitution c'ihm= 


c'ihm(D-3cih-3cihmK')(fiir5>l.dh.5'>0). (36) 
Obige Differentialgieichung hat die Losung 
cihm(4') = crhm(r = 0) . e'-35' + cih(l-e-3^'). (37) 

Wegen des Anfangswertes am Ort der Stufe cihni(<^' = 0) = cjh - 0,5445 (vgL GL (32)) kann die Losung auch als 
cihm(5') '=cih(l -0.4555 . e-3^') 
geschrieben werden, 

Statt eines Dirac-Pulses im Fall der sprungfdrmigen Krummungsanderung gill nun fur die Zeitableitung der 
gemittelten Krummungsanderung 

Mit GL (30) und (38) gilt fur die Zeitableitung der gemittelten Krummungsanderung cihm im Intervall 0<5< 1, 
d. h.furO<lc:^L; 


V / Ic V V 
Clhm=3 — • Cih — 3— . Cihm. (39) 


Aus Gl. (36) bis (38) folgt fur die Zeitableitung der gemittelten Krummungsanderung cihm im Intervall ab 1 
bzw. ^' > 0. d. h. nach vollstandigem Eindringen der Vorausschau in den cth-Stufenbereich: 

cihm = 3^ • cih— 3^ ■ Cihm- (40) 

Da der Ort einer Krummungsanderung (d h. cih-Stufe) in der Vorausschau, und damit die eventuelle ''Ein- 
dringtiefe"2c. jedoch nicht im voraus bekannt ist und nur sehr unzuverlassig aus dem geschatzten cih-Verlauf bei 
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realen, verrauschten MeBwerten ermittelt werden kann, wird naherungsweise die cihm-Dynamik immernach Gl 
(40) modelliert. In der experimentellen Erprobung bzw. im Vergleich zu bekannten Referenzverlaufen aus der 
Simulation lieferte die gemittelte Krummungsdynamik sehr gute Schatzergebnisse (vgl. Schaizwertverlaufe in 
Abschnitt6). 

Hiermit existieren kompakte, sehr einfache Differentialbeziehungen zwischen den fur die optische Fahrbahn- 
verfolgung und Fahrzeugquerfuhrung gleichermafien relevanten gemittelten Horizontalkrummungsparametern 
sowie dem theoretischen (unstetigen) cih-Verlauf. Fur die Zustandsschatzung wird die zeitiiche Anderung von 
cih (theoretisch aus einer Folge von Dirac^Impulsen bestehend, deren Zeitpunkte unbekannt sind) als mittelwert- 

ur^r -I'' gauBverteilter RauschprozeB angesetzt Der Cih-Schatzwert wird somil im Kalman Filter aus- 
schlieUhch uber die Innovation durch die MeQwerte aus der Bildfolge "angetrieben". 

Das Differentialgleichungssystem der horizontalen Fahrbahnkrummungsdynamik lautet dann zusammenge- 


15 


C0hm=«Clhm • V, 
Clhm 

cih = nc,h{t), 


— 3 -jj - CihmH-3 — • Cih, 


20 bzw. in Matrix-Vektor-Notation 


25 


0 

V 0 




0 

0 

__3v 3v 
L L 




0 

0 

0 0 






(41) 


30 


1.3^ Die vertikale Fahrbahnkrummungsdynamik 


I ^n- ^""^^"l /^^.^^J'"".^ ^-2-2 bzw. 1.2.4 erlautert. wird der lokale Vertikalverlauf der Fahrbahn uber der 
Lauflange 2 durch die beiden Parameter der mittleren Vertikalkrummung covm bzw. der mittleren Vertikalknim- 
mungsanderung cwm im Vorausschaubereich bis Ldargestellt. 
35 Analog zu GL (23) im vorigen Abschnitt gilt fur die Zeitableitung der gemittelten Vertikalkrummung 


COhm = 


dCQvn 

dt 


dCOvm dj 

dt 


dl 


(42) 


40 


45 


Die Zeitableitung der ICrummungsanderung cjv, die bei Einfahren in ein im Hohenprofil kreisformiges Fahr- 
bahnsegment (Kuppe, Wanne) wegen des Krummungssprunges theoretisch einen Dirac-Impuls aufweist wird 
ebenso wie ci h im vorigen Abschnitt als mittelwertf reier. weiBer. gauBverteilter RauschprozeB nc, angesetzt 

Das kontinuierhche Teilsystem der gemittelten Vertikalkrummungsdynamik lautet somif 


COvni = Civm • V 


50 bzw. in Matrix-Vektor-Notation 
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0 V 
0 0 


(43) 


1.33 Die Fahrzeug-Querdynamik 

Im 4.D-Ansatz wird u. a. die FCenntnis der aktuellen SteuergroBen und deren Auswirkung auf die Eigenbewe- 
gung des Fahrzeuges (bzw. der Kamera) relativ zur Umgebung dazu genutzt. Veranderungen des Bildes im 
nachsten Verarbeitungszyklus vorauszuberechnen, also zu "erwarten". Fur die Fahrzeugspurfuhrung durch 
Kechnersehen smd neben der Krummung die laterale Fahrzeugposition und Winkellage relativ zu den Fahr- 
bahnbegrenzungen wesentlich. Innerhalb des Fahrbahnerfassungsmoduls muB also die Seitenbewegung des 
Fahrzeugs modelhert sein. Eine gegenuber dem Modell von [Zapp. 88] vereinfachte Modellierung der Fahrzeug- 
querdynamik als System 3. Ordnung mit einem zusatzlichen Integrator als Lenkstellglied erwies sich fur die 
optische Fahrbahn— und Relativlageerfassung als vollig ausreichend. 

Bild Szeigt das Ersatzmodell der Fahrzeugseitenbewegung. 
Modellparameter der Fahrzeugquerdynamik sind 
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aAchi — Achsabstand (3,5 m), 

kr — Reifen-Seitenkraftbeiwert(150 kN/rad). 

m — Fahrzeugmasse (4000 kg), 

V — Fahrgeschwindigkeit. 

In KJammern sind jeweils die Werte fur das Versuchsfahrzeug '^aMoRs" L508D angegeben. 
Die ZustandsgroBen der Seitenbewegung sind 

X — Lenkwinkel [rad], 

P — Schwimmwinkel [rad], 

yv — Seitenablage von der Fahrbahnmitte [m]. 

— Gierwinkel relativ zur Fahrbahniangente [rad]. 

Als abgeleitete GroBe, die nicht expiizit im Modell auftritt. sei noch der Bahnwinkel xv relativ zur Fahrbahn- 
iangente aufgefiihrt. 

Das benutzte Fahrzeugqucrdynamikmodell (vgl. Bild 8) entspricht in seiner Struktur weitgehend dem linearen 
ebenen Einspurmodell nach [Mitschke, 72; Donges. 78], das von [Zapp, 88] fur den Fahrzeug-Querreglerentwurf 
benutzt wurde, jedoch mit folgenden zusatzlichen Vereinfachungen: 

1. Der Fahrzeug-Schwerpunkt wird (symmetrisch) in der Mitte zwischen Vorder- und Hinterachse ange- 
nommen. Dadurch entfallt eine Unterscheidung zwischen der Hebelarmlange vor und hinterdem Schwer- 
punkL Es bleibt nur mehr ein Geometrieparameter aAchs. 

2. Die auf die Reifen wirkenden Umfangskrafte werden vemachlassigt Die Seitenkraftbeiwerte fur die 
Vorder- und Hinterreifen werden gleich groB angesetzt und fur beide Reifen einer Achse im Parameter kr 
zusammengefaBt. 

3. Der EinfluB des Lenkwinkeleinschlags X auf die Gierrate \\fy des Fahrzeugs ist gegeniiber dem Modell 
nach Donges auf eine kinematische Beziehung vereinfacht Unter der Annahme einer symmetrischen 
Schwerpunktlage entfallt zum einen der EinfluB des Schwimmwinkels P auf die Gierwinkelgeschwindigkeit. 
Zusatzlich wird eine kleine geschwindigkeitsabhangige Zeitkonstante von 0,1 bis 0,2 s (bei den in [Zapp.'SS] 
benutzten Fahrzeugparameterwerten) zwischen X und vemachlassigt, die in der urspriinglichen Diffe- 
remialgleichung modelliert isL ' 

Bezuglich des Ansatzes der ursprunglichen Seitenbewegungsgleichungen aus dem Querkraftegleichgewicht 
bzw. Momentengleichgewicht urn die Fahrzeughochachse wird auf [Donges, 78] und [Zapp^ 88] verwiesen. Im 
folgenden werden die Bewegungsgleichungen fur das vereinfachte. ebene Einspurmodell 3. Ordnung mit einem 
Integrator als Stellglied angegeben. 

Die Lenkantriebsdjmamik lautet also 


Fur die Gierwinkelrate abhangig von Lenkwinkel und Fahrgeschwindigkeit kann eine kinematische Naherung 
angewandt werden: Die Querablage der Vorderachse durch ein mit Lenkeinschlag X gefahrenes Weginkrement 
d 1^ ergibt sich fiir kleine X (vgl. Bild 9) zu 

dy«d2 • sinX^tdl^ - X. (46) 

Naherungsweise kann diese Querablage auch uber 

dy^ aAchs • dyvg (47) 

ausgedruckt werden. 
Bild 9 veranschaulicht die Lenkkinematik. 

Durch Gleichsetzen von GL (46) mit (47) und Differenzieren nach der Zeit foigt 
d\|/vg ^ X dj 




dt 


aAchs 


dt 


bzw. 
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a^chs 


• V (48) 


5 fur die inertiale Gierrate des Fahrzeugs aufgrund eines Lenkeinschlags k bei der Fahrgeschwindigkeit v. Die 
(zeitliche) Richtungsanderung der Fahrbahntangente aufgrund des Einfahrens in eine Kurve mit der Krummung 
* coh^^dxR/dj^ergibtsich 2u 


dxR , dl 

10 dr = '°^-"dr 


bzw. 

15 XR=coh-v. (49) 

Fur die relative Gierbewegung zwischen Fahrzeug und Fahrbahn folgt dann aus der Differenz von Gl. (48) und 
Gl.(49) ^ ^ 


20 ■ • X 


aAchs 


V— coh • V. (50) 


Der Bahnwinkel xv des Fahrzeugs reiativ zur lokalen Fahrbahntangente am Ort des Fahrzeug-Schwerpunk- 
25 tes (vgL Bild 6) ergibt sich zu 

XV = M/v + p. (51) 

so daB fur die Bewegungskomponente quer zur Fahrbahnrichtung 

yv « V . sinxv = v • xv (52) 

gilt. 

Das kontinuierliche. lineare und geschwindigkeitsabhangige Zustandsmodell 4. Ordnung der Fahrzeugquerdy- 
35 namik lautet somit zusammengefaBt 

X(t) - kx - ux(t), 

yv(t) = v(t)(yv(t) + m\ 
Vv(t)=-^X(t)-v(t)coh(t), 

bzw. in Matrix-Vektor-Notation 
XV ^ Avxv + bvux+ bcCoh . 
Hierbei bedeuten 
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0 

0 

0 

0 


X 




0 

bp 


0 

0 


P 


0 


0 

0 

V 

0 

V 

Xv = 


by = 

0 

K = 

0 


0 

0 

0^ 




0 




(53) 


mit den Elementen 

■= 2 ( ^) und bp = + CF. 


CF = 


aAchs 


-ap 
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13.4 Das kontinuierliche Gesamtsystem 

Die Systemmatrix des vollstandigen, kontinuierlichen dynamischen Modells des Fahrbahnerfassungsmoduls 
setzt sich aus den Teilsystemen der Fahrzeugquerdynamik Av, der Horizontalkrummungsdynamik Ach» sowie 
der Vertikalkrummungsdynamik Acv zusammen. Als Alternative zur dynamischen Modellierung der vertikalen 
Fahrbahnkrummung wurde auch die Schauung der Fahrbahnbreite als stationarer (aber verrauschter, 'unsiche- 
rer') Parameter realisiert Hierfur mussen die letzten beiden Spalien bzw. die untersten Zeilen der Gesamtsy- 
stemmatrix (Gl. (54)) durch eine Nullspalte bzw. Nullzeile ersetzt werden. 

In Matrix-Vektor-Notation lautetdas Gesamtsystem somit: 

x=» Ax + bu;^-hn 
bzw. ausgeschrieben 
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0 

V 
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V" 

0 
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0 
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0 

0 

0 

— V 

0 

0 

0 
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0 

0 

0 

0 

0 

V 

0 

0 

0 


Cohm 


0 


0 
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wobei aPt bp und cf irh vorigen Abschnitt angegeben sind. Die Elemente der A und b entsprechenden zeitdiskre- 
ten Transitionsmatrix Q> bzw. des diskreten Eingangsverstarkungsvektors g sind im Anhang A3 angegeben. 

1.4 Rekursive Zustandsschatzung als Interpretationsmechanismus 


30 


1.4.1 Zentrale Funktionen der Zustandsschatzung 

Die Zustandsschatzung erfolgt im 4D-Ansatz zur Bildfolgenauswertung iiber ein instationares Kalman Filter. 
Es erfiillt zwei zentrale Funktionen im visuellen InterpretationsprozeB: 

a) Es stellt im Sinne einer abstrahierenden und datenreduzierenden Verarbeitungskomponente eine direkte 
Transformation von Merkmalskoordinaten in der Bildebene in problembezogene, d. h. hier regelungsorien- 
tierte, physikalische GroBen (z. B. Fahrzeugrelativposition und Fahrbahnverlauf) in Raum und Zeit dar. 
Diese Transformation beinhaltet wiederum zwei wesentliche Komponenten: 

i) die Inversion der perspektivischen Abbildung durch die Anpassung der Beweghungsmodelle im 
Sinne kleinster Fehlerquadrate der Vorhersagefehler. 

ii) die Glattung verrauschter ProzeB- und MeBdaten. 

Beide Aspekte werden in einera einzigen Schritt und darait sehr effizient abgearbeiteL 

b) Gleichzeitig bildet die Zustandsschatzung im Sinne einer in der Verarbeitungshierachie nach unten 
gerichteten Verarbeitungskomponente die Kontroll- und Steuerungsinstanz fur die lokale, verteilte Merk- 
malsextraktion. 

Das Grundprinzip der rekursiven Zustandsschatzung zur robusten Bildfolgeninterpretation soil im folgenden 
kurz skizziert werden (eine ausfuhrliche Darstellung der angewandten Verfahren erfolgt in den anschlieBenden 
Abschnitten): 

Mittels der bekannten, modellierten Fahrzeug- und Fahrbahnparameter-Dynamik (letztere infolge der Eigen- 
geschwindigkeit v des Fahrzeugs auf der Fahrbahn. beide zusammengefaBt in Form der Transitionsmatrix <t>{v% 
Gin. (54) bzw. (55) unten) kann ausgehend von einem Schatzwert fiir den aktuellen Systemzustand {it) der 
zukiinftige Systemzustand ( x) zum nachsten Verarbeitungszyklus vorausberechnet werden. Die auf das Fahr* 
zeug wirkenden StellgroBen (u) und die Fahrgeschwindigkeit (v) gehen in die zeitliche Zustands-Extrapolation 
explizit mit ein, zufallige auf das System wirkende Storungen jedoch nicht Uber die nichtlinearen Abbildungsge- 
setzmaBigkeiten {Girt (12) bzw. (56) unten) ist damit auch das 'erwartete' Bild der Fahrbahn berechenbar, in 
Form eines Vektors neuer Merkmalskoordinaten y in der (2D)-Bildebene. Diese Information kann direkt zur 
Steuerung der Merkmalsextraktion verwendet werden, namlich wo im Bild ( = Fensterposition) und in welchem 
Sektor von Vorzugsorientierungen ( ^ Operator-Richtungsauswahl) Kantenkandidaten zu extrahieren sind. 

Die Vorhersagefehler (y y), d.h. die Abweichungen zwischen erwarteten und tatsachlichen Merkmalpositio- 
nen im Bild, fuhren iiber eine Gewichtungsmatrix K zu einer ICorrektur des erwarteten Zustands x (Gl. (58)). 
Dieser als Innovation bezeichnete Schritt bringt durch die MeBwerte neue Information uber den beobachteten 
ProzeB in die Schatzung ein. Die raumlich-zeitliche Modellvorstellung in Form des Zustandsvektors x wird somit 
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den 2D-Szenenveranderungen im Bild nachgefuhrt. 

Axis einem redundanten und mehrdeutigen Satz von Kantenelementen werden nur die selektiert und gehen in 
die Zustands-lnnovation ein, die den envarteten Koordinaten y am nachsten liegen (GI. (57)). Der Selektions- 
schritt wird durch die in der Schaizfehler-Kovarianzmatrix P enthaltene Information unterstutzt die der 'Unsi- 
cherheit' der aktuellen Schatzwerte entspricht: Die Abbildung der um einen Zeitschriti extrapolierten Schatz- 
fehlerkovarianz in den MeBwertraum liefert die sogenannte 'innovations variance' [Bierman, 77]. Diese stellt ein 
MaB fur den zulassigen Toleranzbereich dar, in dem neu extrahierte Kantenelemente um die erwarteten 
Koordinaten y streuen dQrfen. 

Bei sequentieller, skalarer Verarbeitung des MeBwertvektors konnen so 'AusreiOer* eiiminiert werden. D. h. 
mit der Modellvorstellung inkonsistente Kantenkandidaten werden schon vor der Innovation aussortiert Die 
Selektionsf ahigkeit tragt dadurch wesentlich zur Schatzquaiitat ganz besonders aber zur Robustheit des Ansat- 
zes gegenuber Storungen bei. Auch stellt die Anzahl der verworfenen Merkmale unmittelbar ein Bewertungskri- 
lerium fur die akiuelle Obereinstimmung von Modell und Realitat dar. 

Die Abbildungsgleichungen (Gl. (56)) werden hierbei nur vorwarts ausgewertet, d. h. vom Zustandsraum (ais 
'Interpretations-Welt') in den MeQraum (Bildebene) abbildend und damit in der gleichen Richtung wie der 
parallel dazu stattfindende echte', physikaiische Abbildungsvorgang Qber den Sensor. Die nicht-eindeuiige 
inverse Perspektiviransformation von der Bildebene zuriick in raumliche Koordinaten wird umgangen. Sie 
erfolgi implizit bei der Nachfuhrung der Modellvorstellung auf die Szenenveranderungen durch Minimierung 
der Summe der Quadrate der Vorhersagefehler. 

Der Kaiman Filter Algoriihmus wurde in einer optimierten» numerisch effizienten und stabilen Form nach 
[Bierman, 77] implementiert. Hierbei ist die Schatzfehler-Kovarianzmatrix faktorisiert in P==U • D - U*''. wobei 
U eine obere Einheits-Dreiecksmatrix und D eine Diagonalmatrix darstellt Die Anwendbarkeit und hohe 
Effizienz dieses Ansatzes fur die visuelle Bewegungserfassung und -Steuerung in der Robotik wurde erstmals 
von [Wunsche, 86] demonstriert. Der vollstandige Selektions-, Innovations- und Pradiktionszyklus fiir die Kova- 
rianz und den Zustand des dynamischen Modells im Fahrbahnerfassungs-Modul, bei Verarbeitung von acht 
Kantenelementen der Fahrbahnbegrenzungen, wird z. B. in etwa 40 ms Rechenzeit auf einem Objeklprozessor 
(20 MHz 80 386/87) des Multiprozessorsystems ausgefuhrt 

Die grundlegenden Schritte des Zustands-Schatzzyklus bei der Bildfolgenauswertung im •4D-Ansatz' sind: 

Xk = <Dk-i(v) - xk-i +bk-i(v) - uk-i (Pradiktion) (55) 

yk = g( Xk, p) (nichtlineare Perspektivabbildung vorwarts, p enthalt Abbildungsparameter) (56) 
yk = {(yki| tyjci- yki| <e(P)) (Selektion) (57) 
Xk= xt— yk) (Innovation) (58) 

wobei X der Vektor der extrapolierten Zustande und St die vom Filter geschatzten Zustande sind; y beinhaltet die 
Positionen der fiir die Innovation selektierten Merkmale (Kantenelemente). Die Berechnung der Filterverstar- 
kungsmatrix K sowie der Schatzfehler-Kovarianzen P im UD-faktorisierten Verfahren nach Bierman wird in 
Abschnitt 1.43 eingehender erlautert 

ZusammengefaBt bietet der raumlich-zeitlich modellgestutzte, rekiirsive Ansatz zur Bildfolgenauswertung 
folgende Vorteile: 

1) Nur das jeweils letzte Bild der Bildfolge geht in die Verarbeitung ein. Ein Abspeichern von Bildsequen- 
zen, und eine entsprechend zeitlich verzogerte Ruckwartsauswertung, entfallt 

2) Die Pradiktionsfahigkeit Qber das dynamische Modell erlaubt 'Erwartungen* der Szenenveranderungen 
zur KontroIIe und Steuerung der Merkmalsextraktion stiittzend miteinzubeziehen. Dies tragt besonders bei 
hohen Storanteilen oder lokalen Mehrdeutigkeiten im Bild wesentlich zur Robustheit des Ansatzes bei. 

3) Die Anzahl der MeBwerte (verwertete Merkmale) pro Verarbeitungszyklus darf variieren, zeitweise 
kann sogar totales Ausbleiben von neuer MeBinformation uber die dynamischen Modell e kompensiert 
werderL Dies ist in der Bildfolgenauswertung ebenfalls nutzbar bei schlechter Szenenqualitat bzw. sich 
andernden Sichtbarkeitsverhaltnissen, z. B. bei Verdeckungen. 

4) MeBunsicherheiten und Systemstorungen konnen im Kalman Filter explizit beriicksichtigt werden. 
Daruber hinaus lassen sich daraus auch BewertungsmaBe fur die aktuelle Schatzquaiitat bestimmen. 

5) Der Zustandsvektor stellt eine extrem kompakte Datenstruktur zur Beschreibung des momentanen 
Systemzustandes dar. Er eignet sich dadurch sehr gut zu effizientem Informationsaustausch zwischen 
Teilmodulen bzw. zu hoheren Ebenen der Bildauswertung. 

6) Das Verfahren ist in Kombination mit parallelen, lokalen Merkmalsextraktionsverfahren rechentech- 
nisch sehr effizient. Verarbeitungsraten von 10 bis 25 Hz sind fur Modelle achter bis zehnter Ordnung mit 
der derzeitigen Rechenieistung eines einzigen 32-bit Standard-Mikroprozessors ohne weiteres erreichbar. 

1.4.2 Allgemeines zum Kalman Filter 

Das Kalman Filter nach [Kalman, 60] ist ein zeitdiskreter, optimaler Schatzer fur den Zustand eines dynami- 
schen Systems, auf das Steuerungen und stochastische Storungen einwirken. Es stellt einen rekursiven, linearen 
Schatzalgorithmus nach der Minimierung der Summe der gewichteten Fehlerquadrate dar, um den unbekannten 
Zustand eines dynamischen Systems aus verrauschten, zeitdiskreten MeBwerten bestmoglich zu bestimmen. Die 
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statistischen KenngroQen der StorgroBen und MeBfehler werden dafiir als bekannt vorausgesetzt. Die Strukiur 
des Kalman Filters findei sich auch im Luenberger-Beobachter wieder[Brammer a Siffling, 75\ Der Unlerschied 
besteht darin, daB die Rucicfuhrgewichtungen der Vorhersagefehler bei leizterem nichl nach stochastischen, 
sondem nach rein deterministischen Kriterien (vorgegebene Beobachterdynamik) abgeleitet werden. 
Gegeben sei ein zeiidiskretes dynamisches System 

Xk + 1 = OkXk + bkUk + wk (59) 

auf das die ProzeBstorungen wj, einwirken und von dem die mit MeBfehlern Vk behafteten Messungen 

yk==CkXk + vk(furlineare MeBgleichungen) (60) 

bzw. 

yk = g(xk,p) + vk(fur nichtlineare MeBgleichungen) (61) 

zur Verfugung steheh. Die Storungen vk und Wk werden als gauBverteilt. zeitiich unkorreiiert (weiB) und 
mittelwertfrei angenommen. d. h. mit Erwartungswerten E(w) = 0 und E{v) = 0, und den Kovarianzmatrizen 
R = Efww"^} und Q = Ejw'''). Die Systemstorungen und M eflfehler sind zudem untereinander nicht korreliert. 

Fur den Schatzfehler x^^ — x, wobei x den nicht zuganglichen 'wahren' Systemzustand und it den Schatzwert 
darstellt, gelte E(x) = 0 bzw. f iir dessen Ko varianzmatrix P = Ejxx''"}. 

Die konvemionelle Kalman Filter Rekursion zur Berechnung der Schatzfehlerkovarianzen P bzw. der Filter- 
verstarkungsmatrix K(fQrden k-ten Zeitschritt ausgehend von bekannten Anfangskovarianzen Po) lautet: 

Pk - <l>k-iPk-i<I>"^k-i-f Qk-i(Pradiktionj (62) 

Kk = PkC\(CkPkC"^k -h Rk)^^ (63) , . . 

^k = K-JCkCkf^k (Innovation) (64) ' 

Hierbei ist Ck im Fall nichtlinearer MeBgleichungen die Jacobische Matrix der MeBgleichungen zum Zeit- 
punkt k, d. h. die Matrix der partiellen Ableitungen der m-vektorwertigen Funktion g(xk. p) nach den n Element 
ten des Zustandsvektors xk (vgl. auch Anhang A2% 

C^il^. (65) 


Die wesentlichen Nachteile einer Implementierung des Algorithmus in obiger Form bezuglich Rechenauf- 
wand und numerischerEigenschaften sind: • . 

a) Gl. (63) erfordert die explizite Inversion einer n x n Matrix. 

b) In Gl. (64) sind potentielle GroBenordnungsunterschiede der Operanden im Hinblick auf numerische 
Stabilitat und Rechengenauigkeit kntisch. 

1.43 Varianten des Kalman Filter 

Im Rahmen der Raumfahrtprojekte der NASA Mitte der 60er Jahre wurden intensive Weiterentwicklungen 
der rekursiveh Filterverfahren durchgefiihrt. Diese Arbeiten wurden zum efinen wesentlich durch die Implemen- 
tationsbeschrankungen der damaligen Bordcomputer bezuglich Wortlange. Rechenleistung und Arbeitsspei- 
chergroBe motiviert, aber auch generell durch numerische Probleme, die in der konventionellen Formulierung 
des Kalman-Filter-Algorithmus auftreten konnen [Bierman, 77; Maybeck, 79]. 

1.43.1 Sequentielle Filter 

Der zeitaufwendige Schritt einer expiiziten Matrixinversion bei der Berechnung der Schatzfehlerkovarianzen 
laBt sich vermeiden, wenn Rk = Diag(ri) eine Diagonalmatrix ist Dies ist gegeben. wenn die MeBfehler unterein- 
ander nicht korreliert, also unabhangig sind (ein diagonales R ist auch fur korrelierte MeBfehler durch eine 
entsprechende Transformation der MeBgleichungen zu erreichen, vgl. [Chui u. Chen, 87]). Hierbei konnen die 
MeBwerte yi bzw. deren Fehlervarianzen n einzeln (in skalarer Form), nacheinander eingebracht werdea 
Dadurch ergibt sich ein sequentieller Algorithmus anstelle von Gl. (63) und (64), der pro Zeitschritt k fur den 
MeBwertindex i = 1, mk durchlaufen wird (Gin. (56) bis (69)). Die MeBmatrix C wird entsprechend nur zeilenweise 
verarbeitet. Die konventionelle sequentielle Innovation fiir Schatzwert und Kovarianz fiir den i-ien MeBwert 
(mit xio= Xk und Pio= Pk) lautet (zum k-ten Zeitschritt, wobei zur besseren Obersichtlichkeit der Zeitindex k hier 
weggelassen wurde): 

Pi = Pi_, - (Pi-ic^) . . (ciPi^,) (66) 
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mit 

tti^CiPi^iCi'^+n. (67) 

Die Jacobische Matrix C kann hierbei innerhalb eines Zeitschritts konstant bleiben. Fur den Vektor der 
Filterverstarkungen ergibt sich somit 

ki = PiCi"r-l-. (68) 


Die Korrektur des aktuellen Zustandsschatzwerts durch Einbringen des i-ien Meflwerts lautet 

Xi==xj_i +ki[yi— y i]. (69) 
wobei 

yi = gi(xio.p) - gi(x)c,p). (70) 

Die Mairixinversion aus Gl.(63) isi somit auf eine Rekursion mit skalarer Division zuriickgefuhn wordea Die 
sequentielle Verarbeilung skalarer MeBwerte anstatt blockweiser Verarbeitung ganzer MeQwertvektoren kon- 
stanter Lange ermoglicht es zudem, eine jeweils pro Zeitschritt variierende Anzah! mk von MeQwerten zu 
berucksichtigen. Dies ist ein wichtiger Aspekt fur die Anwendung dieser Schatzverfahren zur Bildfolgenauswer- 
tung. Dabei kann sich die Anzahl der aktuell sichtbaren bzw. extrahierbaren Merkmale abhangig von den 
Aspektbedingungen (vgl. [Wunsche, 88]) oder bedingt durch Szeneninhalte und -QuaJitat (speziell im Fall 
naturlicher Szenen) signifikant andern. 

1.43.2 Square-Root Filter 

Eine weitere rechentechnisch vorteilhafte Modifikation des konventionellen Kalman Filters bilden die soge- 
nannten 'Square- Root Filter', wobei Dreieckszerlegungen der Kovarianzmatrix P in der Form 

P = S ■ S"^ . 

benutzt werden. S also einer 'Quadratwurzer von P entspricht. Diese Varianten wurden ursprunglich angegeben 

von [Potter, 64; Andrews. 68]. Abgesehen davon, daO S nur mehr -I!^II±iI anstatt Elemente enthalt und 

Dreiecksmatrizen einfacher zu invertieren sind (sofern uberhaupt notig). ist damit automatisch die definitionsge- 
maBe, aber im konventionellen Fall durch numerische Effekte Verlierbare' Symmetrie von P garantiert. DarQber 
hinaus weisen diese Filter wesentlich bessere numerische Eigenschaften auf, da nur mehr die Quadratwurzeln 
von potentiell sehr groBen bzw. sehr kleinen Elementen vorkommen und damit die GroBenordnungsunterschie- 
de (Exponenten) von Operanden halbiert werden. 

. 1.4.4 Das UD-faktorisierte Kalman Filter 

Eine Sonderform der Square-Root Filter biidet das UD-faktorisierte Kalman Filter nach [Bierman, 75J 
Hierbei ist die n x n Schatzfehlerkovarianzmatrix P faktorisiert in 

P = U-D . U"^ (71) 

wobei D eine Diagonalmairix und U eine obere Einheits-Dreiecksmatrix (d. h. mit Einsen auf der Diagonale) 
darstellt. Die ursprungliche, 'ausmultiplizierte* Form der nxn Kovarianzmatrix P tritt im Algorithmus nicht 
mehr explizit auf. 

Zu den numerisch gunstigen Eigenschaften dieser Faktorisierung in Kombination mit der sequentiellen 
Formulierung des Kalman Filter kommen noch sehr effiziente Implementationsmoglichkeiten, die speziell fur 
Echtzeitanwendungen optimierte Algorithmen ergeben. So werden z. B. Dreiecksmatrizen spaltenweise dicht in 
eindimensionalen Feldern abgelegt. Durch Indextabellen laBt sich der AdreBberechnungsaufwand gegenuber 
2-dimensionalen Feldern wesentlich reduzieren. Auch kann die Besetzungsstruktur der Transitionsmatrizen ggf. 
vorteilhaft genutzt werden. Die Rechengenauigkeit und numerische Stabilitat ubertrifft selbst bei ausschlieBli- 
cher Benutzung von Gleitkommaoperanden einfacher Genauigkeit (32-bit) die des konventionellen. nicht-fakto- 
risierten Kalman Filters bei Verwendung von Variablen doppelter Genauigkeit (64-bit). 

1.4.4.1 Sequentielle Kovarianz-Innovation im UD- Algorithmus 

Der Rechengang fiir die sequentielle, skalare Kovarianz-Innovation (engl. 'neasurement update') in der UD- 
faktorisierten Form entspricht grundsatzlich GL(66) bis (68) unter Anwendung der Substitution P = U • D ■ U*^. 
Er ist detailliert bei [Bierman, 77] oder [Maybeck, 79, pp. 392 ff.] angegeben. Ein zentraler Schritt ist dabei jeweils 
die Faktorisierung einer symmetrischen. positiv semidefiniten Matrix uber eine Variante der sogenannten 
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Cholesky-Zerlegung. 

Der skalare Term aj aus GL (67) wird von [Bierman, 77] als 'innovations variance' bezeichnet. Er gibt die in den 
MeBwenraum (hier Merkmalskoordinaten in der Bildebene) abgebildete Varianz des extrapolierten Schatzzu- 
stands (fur den k-ten Zeitschritt vor Berucksichtigung des i-ten MeBwertes) an, addiert zur Varianz n des i-ten 
MeBwenes. Die 'innovations variance' entspricht somit einer Varianz des Vorhersagefehlers zwischen dem 
neuem MeBwert y\ und dem erwarteten Wert y\ = gi( x. p) aus der Pradiktion. 

Unier der Annahme gauBverteilter Storungen mil Varianz a^yi = ai liegen 99% a!ler MeBwerte in einem Band 
von ±3ayi um den erwarteten Wert y\. Die Innovations- Varianz ai kann somit, wie von [Wunsche, 86; 88] 
realisiert, zur MeBwert-Konsistenzuberprufung bzw, als Selektionskriterium zur Aussonderung von 'MeBwert- 
ausrelBem* angewendet warden. D. h. MeBwerte, die die Bedingung 

|yi- yi| < 3oyi bzw. (yi- y\y < 9a\ (72) 

nicht erfiillen, gehen demnach nicht in die Zusiands- und Kovarianzinnovation ein. Dies tragi wesentlich zur 
Robustheit gegeniiber Storungen bzw. Mehrdeutigkeitcn bei, die sich besonders-in naturlichen Szenen durch die 
lokale Merkmalsextraklion ergeben konnen (vgl. auch Abschnitt 4 zur Merkmalsextraktioii bzw. Abschnitt 6). 
Die im Fahrbahnerfassungsmodul benutzten Werte der MeBwertvarianzen r,, die u. a. in die 'Innovations- Vari- 
anzen* aj und damit in die Bestimmung der Selektionskriterien eingehen, sind im Anhang A4 angegeben. 

1.4.4.2 Kovarianz- Pradiktion im UD-Algorilhmus 

Die zeitliche Extrapolation der Schatzfehlerkpvarianzen nach GL (73) bewirkt immer eine Zunahme der 
Schatz-'Unsicherheit', da unter StorungseinfluB einen Zeitschritt vorausgerechnet wird (vgl. additiver Beitrag 
von Q),ohne daB (zunachst) neue Information uber den Systemzustand mit eingeht, Der Kovarianz- Pradiktions- 
schritt nimmt bei Filtern mit relativ wenigen MeBwerten (d. h. deren Anzahl entspricht etwa der Systemordnung) 
einen signifikanten Anteil des Rechenaufwands pro Zeitschritt ein. 

Deswegen sind speziell bei den Algorithmus-Varianten fiir Echlzeitanwendungen laufzeitoptimierende Imple- 
mentationsaspekte sehr stark beriicksichtigt worden. 

Die konventionelle Kovarianz-Pradiktion lautet 

Pk + i^OkPkOkT + Q,,. (73) 

Mit der Substitution P = Ot>0^bzv/.P^ UC)U''"ergibt Gl.{73) 

U,.,D,,,U:., - *kU,D,Uir<l>J + Q,, (74) 
bzw. mit \V = <D0 als Zwischenprodukt gilt 

U,.,Dk,,UL, = WkD,W:+ Q,. (75) 

In der UD-faktorisierten Formulierung des Kalman-Filter Algorithmus nach Bierman und Thornton gliedert 
sich der ICovarianz-Pradiktionsschritt (engl. auch *time update* oder 'time propagation') grundsatzlich in zwei 
aufeinanderfolgende Unterschritte: 

a) Die MatrixmultipHkation zur Berechnung des Zwischenproduktes W = (I>0. Die Berechnung von >V . 
erfolgt bei allgemeinen, voll besetzten Transitionsmatrizen als konventionelle n x n MatrixmultipHkation. 
Im nicht seitenen Fall einer dunn besetzten Transitionsmatrix <D kann die Matrixmultiplikation jedoch durch 
einen speziellen Algorithmus nach [Thornton u- Bierman, 80] ausgefiihrt werden, der nur die nichtver- 

' schwindenden Elemente von <D benutzt und entsprechend schneller ist. 

b) Die neuerliche Orthogonalzerlegung von t> und Q in U und D, die Faktoren der um einen Zeitschritt 
extrapolierten Kovarianzmatrix P, erfolgt uber den sogenannten *modifizienen Gram-Schmidt' Algorith- 
mus [Lawson u. Hanson, 74; Stewart, 79; Maybeck, 79]. 

Die 'modifizierte Gram-Schmidt-Orthogonalisiening* ist Kern der Zerlegimg von ^ und D und soil hier kurz 
skizziert werden, da im folgenden Abschnitt eine laufzeitreduzierende Implementationsvariante diskutiert wird. 
Fur die gewichteten Skalarprodukte zweier Vektoren wird die Notation 

n 

[v,w]wd = vD^Dw X vD.w,,, (76) 
I I 

und 


|v|i = V^D V = y; V?D;;. (77) 

i - 1 
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eingefUhrt 

Die neuen UD-Faktoren 0 und D von Din Gl. (75) werden rekursiv uberdie folgenden Schritte fur j=:n, n— 1 
. . . , 1 berechnet (der Rekursionsindex ist hochgestellt, gegenuber tiefgesetzten Zeilen- oder Spaltenindizes): 

5 

'^U = (78) 

(79) 
(80) 

15 Eine sehr effizienie FORTRAN-Implementation dieses Algorithmus, unter Benutzung vektorgespeicherter 
Matrizen, wurde von Tnornion und Bierman angegeben. Eine leicht modifizierte Variante dieses Algorithmus 
gab [Wunsche, 88] an, wobei die Kovarianzmatrix der Systemstorungen Q ais reine Diagonalmatrix eingeht 
Dadurch ergeben sich weitere laufzeitreduzierende Vereinfachiingen. Die Kovarianzmatrix Q der diskreten 
Systemstorungen wurde hier ebenfalls als konstante Diagonalmatrix angesetzL Deren Elemente wurden Qber 

20 den ProzeQ des sogenannten 'filter tuning* [Maybeck. 79] iterativ-experimentell bestimmt (die Werte der Q-Ele- 
menie sind zusammen mit den Anfangswerten der Schatzfehlerkovarianz im Anhang A4 angegeben). 

1.4.4.3 Laufzeitoptimierung der UD-Kovarianz-Pradiktion unter Berucksichtigung der (P-Besetzungsstruktur 

25 Die Transitionsmatrix <t> der Bewegungsgletchungen technischer Systeme kann bei geringer Kopplung der 
Bewegungsfreiheitsgrade, wie auch im hier beschriebenen Anwendungsfall, blockweise Dreiecksstruktur oder 
dreiecksahnliche Besetzungssiruktur aufweisen. Dies trifft auch auf zwei weitere Systeme zu, deren Bewegungs- 
erfassung mittels Rechnersehen und dem UD-faktorisierten Filteransatz am Institut fur Sysiemdynamik und 
Flugmechanik untersucht wurden: a) das Satelliten-Andockmanover [Wunsche, 86; 88],.und b) die Relativlage- 

30 schatzung zu Hindernissen von einem StraBenfahrzeug aus [Christians et aU 89]. 

Bei Verarbeitung von relativ wenigen MeBwerten durch das Filter, d. h. deren Anzahl entspricht der System- 
ordnung oder ist noch kleiner, biidet die Kovarianz-Extrapolation den groBten geschlossenen (unteilbaren) 
Rechenzeit-Block innerhalb eines Zeitschritts. Im vorliegenden Fall wurden bei Systemen achter bzw. neunter 
Ordnung Rechenzeiten von ca. 12 bis 16 ms fur die Kovarianz-Extrapolation benotigt (auf 80 386/387, 20 MHz, 

35 ohne Wartezyklen), wogegen fur die sequentielle Innovation pro MeOwert nur 2,3 bis 2J ms erforderlich sind. 
Bei einer Gesamtzykluszeit von 40 ms (zwei Bildtakte bei 50 Hz Bildfrequenz) stellt dies einen signifikanten 
Anteil der zur Verfugung stehenden Rechenzeit dar.. 

In weiterfuhrenden Untersuchungen von Anwendungen des UD-faktorisierten Ansatzes wurde von [Bierman, 
81] u. a. auf die Moglichkeit hingewiesen, Blockdreiecksstrukturen der Transitionsmatrix zur Laufzeitverbesse- 

40 rung bei der Kovarianz-Pradiktion zu berucksichtigen. Wegen des oben erwahnten hohen Rechenzeitbedarfs 
relativ zur Gesamtzykluszeit, und da die Transitionsmatrix hier unterhalb der Diagonalen weitgehend unbesetzt 
ist, wurde diese Eigenschaft der Besetzungsstruktur von <D zur weiteren Reduzierung.des Rechenaufwandes 
genutzt Hierbei konnen unbesetzte Bereiche unterhalb der Diagonalen zeiienweise berucksichtigt werden. 
Die Transitionsmatrix O des Gesamtsystems der Fahrzeugquerdynamik und der Fahrbahnkrummungsdyna- 

45 niik (vgl. Anhang A3) weist hier folgende Besetzungsstruktur auf: 

Bild 10: 

Die Besetzungsstruktur der Transitionsmatrix des Fahrbahnerfassungsmoduls 
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60 

Hierbei sind von n^^si Elementen kn2 = 24 ungleich Null (Anteil Xn2=kn2/n2 = 30%) bzw. unterhalb der 
Diagonale sind l2=32 unbesetzt (Anteil Xu= lz/n2 = 40%). Zum Vergieich seien auch die entsprechenden 
Besetzungsdichten der oben erwahnten Anwendungen angegeben: 

65 
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System Kz '^\z 

Fahrzeug/Fahrbahn 30% 40% 

a) Satellitendocking 23% ' 42% 5 

b) Fahrzeug/Hindemis 16% 44% 

Die diinne Besetzungsdichte Xnz wird bereils im 'sparse O multiplication* Algorithmus von [Tliornton a 
Bierman. 80] bei der Berechnung von W = <I)U genutzt, um die Anzahl der Gleitkomma-Operationeh des Typs lo 
A: = A -r B • C proportional zur Besetzungsdichte Xnz zu reduzieren. 

Im ursprunglich angegebenen Algorithmus wird jedoch im darauffolgenden Schritt (GL (75)) der neuerlichen 
Faktorisierung uber den 'modifizierten Gram-Schmidt Algorithmus' die von <t> auf W ubertragene Besetzungs- 
struktur noch nicht beriicksichtigL Wegen der oberen Dreiecksform von U bleibi namlich bei der Matrixmulti- 
plikation W=<I>U die Besetzungsstruktur von <D erhalien. is 

Im Gram-Schmidt Algorithmus werden innerhalb einer zweifach geschachtelten Schleife (vgl. GL (79)) aus 
Zeilenvektoren von W die gewichteten Skalarprodukte der Art [wj, wJC) gebildet. Die zur Skalarproduktberech- 
nung notigen Operationen, in einer dreifach geschachtelten Schleife ausgefuhrt, werden also proportional n^ 
wiederholt. Hierbei werden die Zeilenvektoren Wi elementweise von links nach rechts verarbeitet. Da W die 
gleiche Besetzungsstruktur wie O besitzt (vgl. Bild 1 0), die ersten nsi Elemente jeder Zeile von W gleich Null sind 20 
und somit keinen Beitrag zum Skalarprodukt liefern, konnen pro i-ter Zeiie von W jeweils njj Schleifendurchlau- 
fe in Gl. (78) und (79) weggelassen werden, 

Daraus resultiert eine stgnifikante Verringerung der Rechenzeit fiir die UD-Kovarianz-Pradiktion, die bei den 
gegebenen Systemordnungen etwa proportional zum Anteil der NuUelemente unterhalb der Diagonalen in O ist, 
hier also ca. 40% betragt (bei hoheren Systemordnungen aber noch groBer sein kann). Die Laufzeiien der 25 
ICovarianz-Pradiktion fiir ein System achter Ordnung konnten damit von 11,8 auf 63 ms reduziert werden. fiir 
ein System neunter Ordnung von 15,8 auf 9,6 ms. • ' 

Gegenuber der Algorithmusversion nach Bierman, die in [Wiinsche, 88] angegeben isi, muBten als Anderun- 
gen nur ein weiteres Indexarray der Dimension n als Obergabeparameter eingefiihrt werden, sowie die Start- 
werte zweier Schleifenindexvariablen von 1 auf nsi gesetzt werden. Das Indexarray enthalt die Spaltenindizes 30 
des jeweils ersten nichtverschwindenden Elementes einer Transitiorismatrixzeile. Insgesamt wurden damit nur 
drei Statements modifiziert um obige Laufzeitbesserung zu realisieren- 


Anhang Al zu Abschnitt 1^.3 

Die Elemente der Jacobischen Matrix der MeBgleichungen 

. Die Abbildungsgleichung Gl. (12) laBt sich verallgemeinert als Funktion gi des Zustandsvektors x und der im 
Vektor pi zusammengefaOten Abbildungsparameter ( Cy^^b* vk) darstellen als 


Q ^ (x,p) 


, (A 1.3) 


Aye = C • Ax. (A 1.4) 

Fur das dynamische Modell mit Horizontalkfiimmungserkennung und Fahrbahnbreitenschatzung (d. h. fur 
den Fall einer ebenen Fahrbahn) enthalt der Zustandsvektor die Elemente 


P> Xv, *V, Cohm, Clhm. c,h, b) . (A 1.5) 


35 


40 


yBi'=gi(x,pi), (A 1.1) 

bzw. vektoriell geschrieben 

yB = g(x.p). (A 1.2) 45 

Hierbei ist ys der Vektor der (bis zu 8 verwerteten) horizontalen Bildkoordinaten der Fahrbahnbegrenzungen 
an verschiedenen Vorauschauentfernungen Li. 

Die MeBmatrix C gibt im Fall nichtlinearer Abbildungsbeziehungen den linearisierten Zusammenhang zwi- 
schen einer (kleinen) Anderung des Zustandes Ax um den aktuellen Zustand xo und der entsprechenden 50 
Verschiebung der Merkmalskoordinaten Ays im Bild an. Sie ist die jacobische Matrix der Abbildungsgleichun- 
gen, d. h. die Matrix der partielien Ableitungen der Elemente von g nach den Elementen des Zustandsvektors x: 


55 


60 


65 


Die ZustandsgroBen X, P und cih gehen nicht in die Abbildungsbeziehungen GL (12) ein. Damit ergibt sich fiir 
die i-te Zeile ci (bzgl. des i-ten Bildkoordinaten-MeBwerts) der MeBmatrix C: 
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_1_ 

L. 


L, + d 
L, 


(L. + d)^ 
2 Li 


6L. 


(A 1.6) 


5 wobei +b/2 fiir Bildkoordinaten-MeBwene der rechten und -b/2 fur solche der linken Fahrbahnbegrenzung 
TL'r '^^Tt?^,^^f '^^^^^^^^^ Fahrbahaverlaufes. d. h. mit Vertikalkrummungser- 


kennung. enthali der Zustandsvektor die Elemente 

10 x''" ^ (^P«yv,\|/V.COhm.Cihm.Clh.C0vm,Civm). (A 1.7) 


H.erbei ist die Vorausschauentfernung L abhangig von den VertikalkrummungsgroBen covm und cwm. d. h. 
abhangig vom aktuellen Zustand xp (vgl. vertikale Abbildungsgeometrie. Abschnitt 5.2.4). Die i-te Zeile cr/b-ffl 
des i-ien BiIdkoordinaten-MeBwerts ysi) der Jacobischen Matrix C der MeQgleichungen lauiet hierfur- 


15 


20 


25 


1 

L, + d 

(L, + df 1 

(L. + d)^ 

Li 

L. 

2L. 1 

6L, 


(A 1.8) 


Erne analytische Differentiation der Abb.ldungsgleichung GI. (12) nach den Vertikalkrummungszustanden 
covm und ci vm ist nicht mehr moglich. da fur die Abhangigkeit der Vorausschauweite L von den Vertikalkriim- 
mungszastanden kern analytischer Ausdruck vorliegL Die partiellen Ableitungen ayai/acovm bzw. ayaiacwm zum 
aktuellen Zustand Xo werden dann uber numerische Differentiation bestimmt yB.^cwm zum 


30 und 


^ Ays, 


_ Aye, 

'^Civm AC|y^ 


«0 


2 Ccv 


(A 1.9) 


(A LIO) 
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Anhang A2 zu Abschnitt 1 3 
Die Elemente des diskreten Zustandsraummodells 

v.?hI^ p" ^-^ ^""f^^^ der Fahrzeugseitenbewegung bzw. der Fahrbahnkrummungsdynamik (GI. (54)) ist 

von der, Fahrgeschwindigkeit v als auch evtl. von der Vorausschauweite L abhangig. Die Elemente der Transi 
tionsmatnx O und des diskreten Stellverstarkungsvektors g mussen daher z/fedem Arastzeitpunl Tu 
berechnet werden. D.h. fur diese GroBen mOssen entsprechende analytische Ausdaicke vorliegen Innerhal^ 
eines Abtastschnttes werden L und v als konstant angenommen. ^ innernaiD 

Uber die Laplace-Transformation lassen sich die Elemente der Transitionsmatrix in analytischer Form aus der 
kontmuieriichen Systemmatrbc herleiten (vgl. [Ackermann. 83]): 

CI>(T)«L-V(sl-Ar'). (AZ\) 

Fur den diskreten Eingangsverstarkungsvektor g abhangig von <D und b gilt 

T 

55 g = J ^Wb dr. (A 2.2) 

Aus dem kontinuierlichen Zusiandsraummodell A, b ergibt sich damit die entsprechende diskrete Darstellung 


50 


zu: 


60 
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4> = 


1 

0 

0 

0 

0 

0 0 

0 

0 


gi 

<P2I 

<P22 

0 

0 

0 

0 0 

0 

0 




<PJ2 

1 

<P34 

<P35 


0 

0 


By 

941 

0 

0 

I 


946 94 7 

0 

0 


g4 

0 

0 

0 

0 

1 

<P56 957 

0 

0 

, und g = 

0 

0 

0 

0 

0 

I 

966 967 

0 

0 


0 

0 

0 

0 

0 

0. 

0 1 

0 

0 


0 

0 

0 

0 

0 

0 

0 0 

1 

989 


0 

0 

0 

0 

0 

0 

0 0 

0 

1 


0 


(A 2.3) 


10 


Fur die Modellvarianie mit Fahrbahnbreitenschatzung ansielle der Vertikalkrummungserkennung ist in der js 
obigen Transitionsmatrix nur die letzte Spalte bzw. Zeile zu streichen; ansonsten bestehen keine Unterschiede in 
den diskreien Formen der dynamischen Modelle. 

Mit den Faktoren 


CF 


aAchs 


ap=2(--JS--). 
\ m • V / 


bp^ 


kr 


m • V 


+ CFund 


ac=-3- 

ergeben sich fur die nichtverschwindenden bzw.nichttriyialen Elemente der Transitionsmatrix folgende jerme: 
2. Zeile 

I --^(e^^^-l); 922 = e»FT; 


3. Zeile 


bpv /e^F"^- I CpvT^ V 


934 vT; <p3j = - 


937 


V . 2a, 6 J' 


4. Zeile 


94, = CpT; (p,5 = - vT; = -^{^J^ 1 - e"-"^); 


947 


n a,^ 2a,/ 
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5. Zeile 

<P56 = - — (1 - e-cT) . (P57 = -X- (a,T + 1 - Cc'^) ; 

6. Zeile 

<P66 = e"cT; cp67 = 1 - e'c^; 
'0 8. Zeile 
V89 = vT. 


15 Die Ausdrucke fur die nichtverschwindenden Elemente des diskreten Eingangsverstarkungsvektors g lauten: 


20 g2 


30 


g. = -^. 

Anhang A3 zuAbschnitt 1.4.4.1 
Die Elemenle.derMeflfehler-Kovarianzmatrix R 
Fur die Varianzen der MeBfehler. die als unkorreiiert angenommen werden. 
35 R = Diag (n) - Diag {ax\ a\^^ . aK^2 • • • • ^^y^sa) 

warden im Fahrbahnerfassungsmodul folgende Werie angesetzt: 
ox^ = 1 .OE-6 [rad^] bzw. a^y^^ = 5,0 [px\^ 

40 ■ • 

Die Streuung des LenkwinkelmeBwerts ax=l,0E-3 [rad]=. 0.057 entspricht somit etwa einem viertelten 
Quantisierungsschritt des mit 0^4^ Auflosung digitalisierten Lenkwinkels. Fur die Streuung der KLantenkoordi- 
natenmeBwerte in naturlichen Straflenszenen wurde ayBi=:.2.24 [pxl] angesetzt, womit aUch einer gewissen 
Kanten- Unscharfe' von nicht markierten, unregelmafiigen Fahrbahnbegrenzungen. wie z. B. bei einem direkten 
45 ubergang von Asphalt zu Gras, Rechnung getragen wird. 

Anhang A4 zu Abschnitt 1.4.4.2 

Die Elemente der Systemstorungs-Kovarianzmatrix Q und die Anfangswerte der Schatzfehlerkovarianzmatrix 
50 Po 

Die Kovarianzmatrix Q der diskreten Systemstorungen wurde fQr das Fahrbahnerfassungsmodul als konstan- 
te Diagonalmatrix angesetzt. Deren Elemente wurden uber den ProzeB des sogenannten 'filter tuning' [Maybeck. 
79] iterativ-experimentell bestimmt zu 

55 

Q-Diag(1.E-7, l,E-5, LE-4. l.E-7. 

l.E-9. l.E.ll,l.E-10,3.E-9,l.E-10}. (A 4.1) 

Die dabei gemachten Vereinfachungen, d. h. die Vernachlassigung der Nebendiagonaleiemente sowie der 
60 Geschwindigkeitsabhangigkeit, erwiesen sich aus folgenden Grunden als sinnvoll und zulassig: 

— In der Praxis hat sich ein konstantes, diagonales Q bewahrt. 

— Die numerische Berechnung von Q (diskret) aus einem kontinuierlichen, diagonalen Q uber die Integra- 
tion ^ 

65 
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1 


"I>(v,t) 5<1>'(v.t) dr (A 4.2) 


(vgl.[Bran»ner u. Sifning, 75. pp. 93 ff]) ergab schon eine deutliche Diagonaldominanz der Elemente von Q. 

Daruber hinaus wiirde eine expiizite on-line Berechnung von Q uber obige Beziehung selbst bei Vernachlassi- 
gung aller Terme mit hSheren Potenzen als T einen nicht unerheblichen Rechenmehraufwand fur die Kovari- 
anz-rradiktion bedeuten. 

Im Gegensatz zu Q und R. welche das langfristige' Filterverhalten beeinflussen. wird durch die Anfangsschatz- 
fehlericovananz Po hauptsachiich das Einschwingverhalten bestimmt. Als gunstigc Wahl fOr schnelles Einschwin- 
gen envies sicn die Besetzung 

Po = Diag {0,1 , 0, 0, 1 . 0, 1 , 0, 1 . 0, 0, 0, 1 , 0). (A 43) 

^„i'.^hj!:"iS?r7 n'*" Schwimmwinkels sowie der Kriimmungsanderungen (im Stand) werden als exakt 
angesehen. MitPoalsDiagonaltnatrixgiltzusatzlich 

Do = Po sowie Uo = I, (A 4.4) 

womit sich also eine anfangliche Zerlegung von Po erubrigt 
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PatentansprQche 

1. Verfahren zur kontinuierlichen und automatischen Fahrzeugorientierung auf einer Fahrbahn mit einem 
bilderzeugenden System und einer computerisierten Bildauswertung zur Erzeugung von Fahrzeugsieuer- 
daten, dadurch gekennzeichnet daB die Bilddaten eines letzten monokular erzeugten Bildes einer fortlau- 
fenden Bildfolge mit Hilfe eines einen elektronischen Rechner steuernden Programms, orientiert an raum- 
lich-geometrischen und zeitlich-dynamischen Aspekten einer Szene. modeliiert werden, um sie dann mittels 
rekursiver Schatzverfahren zur Bestimmung der StraDenparamter, speziell des horizontalen und des verti- 
kalen Kriimmungsverlaufs im Vorausschaubereich sowie der Breite und der eigenen straBenbezogenen 
Situation heranzuziehen. 

2. Verfahren nach Anspruch 1 dadurch gekennzeichnet. daB ein kompletter Verfahrenszyklus inklusive 
einer Aktuahsierung der Steuerdaten 1/10 bis l/30Sekunden dauert 
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DE 4124654 A UPAB: 19930924 

The method involves using an image generating system and a computerised 
image processor to produce vehicle control data. The image data of one 
monocular image of a sequence of images is modelled by orientation with 
spatially geometrical and temporally dynamic aspects of a scene, using a 
program-controlled computer. 

A recursive estimation procedure is used to determine the road 
parameters, i.e. the predicted horizontal and vertical curve paths, as 
well as the road width and the characteristic road situation. A complete 
cycle of the procedure, including the utilisation of the control data, 
pref. lasts 1/10 to 1/30 of a second. 

USE/ADVANTAGE - For automatic vehicle guidance. Interprets monocular 
image data from camera mounted on vehicle, for determination of road 
course . 
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